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I .  Introduction 


Much  of  the  summer  project  (1981)  period  wee  devoted  to  an  understanding 
of  the  extended  Kalman  filter  and  to  how  the  Autofocus  measurement  could  be 
implemented  using  the  versatile  Monte  Carlo  simulation  program  called  SOFe/*^ 
Using  the  45th  order  dynamics  of  a  Honeywell  LN-15  local-level  INS  truth 
model,  a  13th  order  approximating  filter  was  chosen  and  a  linearized  Autofocus 
measurement  matrix  derived.  With  a  typical  "climbing"  trajectory  generated 
by  the  orogram  PROFGEN,  the  system  was  run  over  various  sections  of  aircraft 
trajectory  at  high  measurement  S/N  ratios  and  without  any  additional  scaler 
measurements  used  to  supplement  the  Autofocus  measurement.  Generally, 
the  update  quality  of  the  Autofocus  measurement  was  disappointing  with 
a  good  initial  update  being  followed  invariably  by  a  confused,  "wandering" 
update.  (Appendix  A  includes  the  entire  suwnev  project  final  report  for 
background  information) .  Since  the  observability  matrix  of  the  system 
was  determined  to  b<  singular,  it  was  concluded  (by  default)  that  the 
nonobservability  of  the  system  when  coupled  with  the  high  measurement  S/N 
ratio  was  perhaps  introducing  a  significant  roundoff  error  instability 
into  the  update  m  chanism  and  was  therefore  the  source  of  the  poor  performance. 
This  instability  phenomenon!  has  been  frequently  reported  in  the  literature 
but  it  was  a  somewhat  unsatisfying  explanation  since  roundoff  problems 
do  not  usually  occur  on  the  WPAFB  CYBER  64  bit  machine.  Furthermore,  little 
problem  was  experienced  with  either  filter  divergence  or  with  the  covariance 
matrix  converging  to  a  nonpositive  definite  steady-state  solution.  In 
short,  the  alleged  nonobservability  effect  was  a  questionable  explanation 
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but  it  was  the  most  plausible  one  available.  The  only  other  possible 
explanation  vas  that  the  Autofocus  measurement  was  simply  too  ambiguous 
or  too  loosely  coupled  to  the  state  vector  to  be  a  useful  scaler 
measurement.  However,  this  last  explanation  was  not  consistent  with 

the  uniformly  good  initial  updates  achieved. 

II.  Description  of  Computer  Runs  Performed  in  Summer  of  1982 

A.  General  Remarks 

The  system  as  of  6/30/82  included  only  the  Autofocus  measurement 
in  the  centripedal  acceleration  mode.  The  trajectory  used  was 
the  original  trajectory  tape  of  the  summer  of  1981  which  featured 
a  slow  climb  and  leveling  out  manuever.  During  the  spring  of 
1983,  the  line  of  sight  (L.O.S)  acceleration  term  was  added  to 
the  measurement.  All  measurements  in  the  project  were  high  S/N 

measurements  and  were  simulated  as  such.  Error  feedback  after 
update  was  used  until  10/83.  Error  feedback  created  a  subtle  problem  in 
evaluating  the  quality  of  the  update  and  was  also  thought  to  have 
generated  an  error  propagation  path.  Process  noise  was  added 
to  the  covariance  propagation  model  in  order  to  control  filter 
divergence.  The  observed  update  performance  did  not  seem  to  be 
sensitive  to  the  magnitude  of  the  process  noise  in  most  instances 
although  filter  divergence  occurred  if  no  noise  was  added. 

B.  Check  for  Algebraic  Sign  Tirror  and  Preliminary  Runs 

A  common  problem  in  Kalman  filter  simulation  work  is  the  occurrence 
of  simple  algebraic  sign  errors  in  the  measurement  simulation 
(HRZ  subroutine  in  SOFE)  section.  In  order  to  gain  confidence 
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that  a  good  update  was  even  possible  with  the  truth  model  used, 

13  separate  measurements  were  postulated  at  high  S/N  ratios  for 
each  of:  the  13  filter  state  variables.  Excellent  updates  were 
observed  along  with  strong  covariance  updates;  with  confidence 
in  the  simulation  implementation  acquired,  various  combination 
of  state  variables  were  measured  independently  with  or  without 
the  Autofocus  measurement.  It  was  observed  that  tdiile  the  Autofocus 
provided  some  useful  update  information  by  itself,  it  did  benefit 
greatly  from  a  supplementary  measurement  on  the  velocity  vector. 

It  was  also  observed  that  latitude  and  longitude  updated  well 
when  each  velocity  component  was  measured  Independently.  This 
vas  not  surprising  since  latitude  and  longitude  are  position 
variables  which  are  strongly  coupled  to  the  velocity  vector. 

C.  The  PBH  Test  for  Observability;  The  Eigen^alue/vector  of 

Matrix;  and  Elimination  of  the  Error  Feedback  Mode 

In  the  8/82  to  9/82  period,  a  number  of  useful  steps  were 
taken  to  resolve  the  observability  question.  During  the  summer 
of  1981,  the  observability  matrix  was  programmed  in  the  user 
routine,  ESTIX;  the  determinant  of  the  matrix  was  formed  and 
found  to  be  zero  for  all  runs  which  indicated  a  nonobservable 
system.  Tnis  fact  alone  pic^ides  little  information  since  any 
nonobservable  state  variable  will  cause  a  zero  determinant  even 
if  it  is  too  loosely  coupled  to  the  system  to  have  any  real  effect 
on  system  performance.  Condition  numbers  can  of  course  be  defined 
on  the  matrix  eigenvalues  but  these  indexes  are  misleading  and 
are  usually  sensitive  to  the  wrong  factors.  In  the  present 
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investigation,  the  PBH  test  was  used  to  investigate  nonobservability. 
Briefly  stated,  che  PBH  test  indicates  the  nonobservabiity  of  a  system 
if  and  only  if  there  exists  an  eigenvector  of  the  system  matrix,  A 
that  is  orthogonal  to  the  measurement  vector.  (The  proof  is  available 

(o' 

in  Kailath  ).  Accordingly,  the  eigenvectors  of  the  system  matrix 
vsre  generated  in  ESTIX  by  using  the  IMSL  routine  EIGRF  and  then  used 
to  form  a  generalized  inner  product  with  the  measurement  vector.  In 
order  to  portray  the  "degree"  of  orthogonality  or  observability,  a 
generalized  cos(0)  was  then  formed  over  the  complex  field  as 


where  a£  is  the  ith  component  (in  general  complex)  of  the  eigenvector 
of  A  and  in  the  i^  component  of  the  measurement  vector.  For  the 
Autofocus  only  measurement,  the  above  measure  was  s  0  for  7  of  the 
13  variables  and  was  around  0.6  for  the  other  6  variables.  Since 
simulation  runs  indicate  significant  updates  only  for  the  position 
and  velocity  variables,  it  can  be  concluded  that  these  variables  are 
the  only  strongly  observable  ones  and  that  the  seven  other  variables 
(attitude,  bias,  and  gyro  drift  states)  are  only  weakly  observable 
with  the  centripedal-only  Autofocus  measurement.  It  is  interesting 
to  speculate  that  the  measure,  cos(9),  may  indicate  the  degree  of 
measurement  observability  which  would  then  reflect  either  the  number 
of  updates  required  for  a  given  measurement  to  update  the  state  vector 
or  the  sensitivity  of  the  state  vector  update  quality  to  measurement 


noise.  As  support  for  the  significance  of  the  magnitude  of  cos(6), 
the  Autofocus  measurement  with  the  L.O.S.  term  has  9  observable 
variables  but  no  cos(0)  exceeds  the  value  of  0.2.  and  the  measurement 
does  not  update  as  well  for  the  same  number  of  updates  as  the  centripedal 
only  case. 

The  error  feedback  was  also  discontinued  in  10/82  and  the  error 
of  update  defined  as 

update  error  -  1  x  100X  (2) 

(XS(i> | 

was  calculated  and  printed  out  in  ESTIX. 

Resolution  of  Observability  Question 

As  of  11/82,  the  identity  of  the  weakly  observable  state  variables 
was  known.  It  remained  to  determine  what  effect,  if  any,  they  had 

on  the  mediocre  Autofocus  update.  The  definite  test  was  taken  by 
removing  the  "nonobservable"  variables  from  the  filter  and  then  observing 

the  update  quality.  This  procedure  was  performed  by  setting  the 

appropriate  filter  model  derivatives  to  zero.  No  significant 
degradation  in  the  Autofocus  update  was  observed  which  led  to  the 

conclusion  that  at  least  for  the  Autofocus  measurement  alone,  no 
significant  effect  due  to  nonobservability  is  present.  This  does 
not  mean  that  that  the  altitude/drift  variables  can  not  be  updated. 

They  can  be  updated  especially  with  additional  measurements  but  the 
update  is  a  slow  one  due  to  the  very  low  value  of  cos(0^).  This  slow 
update  situation  can  also  be  explained  by  the  near  orthoganality  of 


the  measurement  vector  and  the  eigenvectors  of  associated  with 
the  poorly  observable  states.  Horv  will  be  said  on  this  in  a  later 
section. 

In  conclusion,  the  observability  problem  does  net  appear  to  be 
the  couse  of  the  mediocre  Autofocus  update.  It  should  be  noted  that 
the  same  result  could  be  revealed  from  matrix  partitioning  as  well. 

If.  should  be  acknowledged  that  the  PBH  test  applies  only  to  the 
time  invariant  systems  as  do  the  usual  tests  on  the  observability 
matrix.  In  a  time  varying  system,  as  considered  in  this  project, 
the  usual  measure  of  observability  oust  be  modified  slightly. 

Nevertheless,  the  003(6^)  can  be  a  useful  indicator  of  the  type  of 
coupling  that  exists  between  measurement  and  state  vectors. 

The  Introduction  of  Additional  Measurements 

Referring  to  Table  Bl,  of  Appendix  B,  an  Autofocus  measurement 

alone  is  presented  for  t>0  with  a  time  between  updates  of  8  sec.  and  a 
time  delay  before  the  first  update  of  48  secs.  Through  20  updates,  the 
update  error,  measurements^  in  percentages^ for  the  first  six  state 
variables  are  (64,  43,  114,  61,  22,  115)  respectively.  It  is  apparent 
that  the  scaler  Autofocus  measurement  needs  an  additional  measurement 
to  improve  the  update  quality.  Considering  the  Autofocus  value 
measurement  as  a  plane  In  state  error  space  defined  by 


Autofocus 

Measurement 


■  K  VVE  +  H5SVN  +  VVZ 


(3) 


where  H^,  H^,  Hg  are  components  of  the  measurement  vector  and  the 

(6V  ,  SV„,  6V„)  are  components  of  the  velocity  error  vector,  we  can 
E  N  ^ 


consider  the  first  update  as  the  optimum  update  given  the  position 
of  the  measurement  plane  relative  to  the  covariance  ellipsoid. 

Depending  on  the  relative  positioning  of  the  plane  end  ellipsoid, 
tha  state  error  vector  will  be  restricted  to  e  certain  defined  region 
of  state  error  space  which  represents  the  geometrically  underdeternined 
nature  of  the  measurement .  Repeated  Autofocus  measurements  will  cause 
the  error  vector  to  wander  about  this  region  due  to  the  Influence 
of  unmodeled  state  variables.  Any  additional  scaler  measurement 
should  reduce  the  "volume"  of  this  region  of  uncertainty  and 
therefore  Improve  the  reliability  of  the  update. 

F.  The  introduction  of  The  Compass  Measurement 

A  logical  supplementary  measurement  is  a  Compass  measurement 
which  measures  heading,  0,  given  in  terms  of  the  east  and  north 
velocity,  V£,  VN>  components  as 


9  =  tan 


-1  VE 


which  yields  a  measurement  matrix  row  entry  of 


1+<V 


1+<V 


j  and  which  also  introduces  a  new  measurement  plane  defined  by 


£om>ass  measurement  «  V£  +  H5<5VN,  that  further  restricts  the  volume  of 
in  the  state  vector  error  ellipsoid.  Indeed,  the  Autofocus  and  Compass 
measurement  would  determine  the  velocity  state-error  vector  uniquely 
were  it  not  for  the  dependence  of  the  Autofocus  on  the  unknown  vertical 
velocity  component.  Accordingly,  it  would  be  reasonable  to  expect 


th*  b*st  update*  to  occur  In  level  flight  Where  3  0.  However* 
this  la  exactly  th*  opposite  of  whet  actually  occurred.  For  the  level 
flight  period  around  t  ■  16  minutes*  the  update  becaa*  quite  shaky  for 
the  simple  reason  that  the  Autofocus  and  Coapaaa  measurement  planes 
began  to  approach  a  parallel  state  in  which  their  region  of  intersection 
became  very  sensitive  to  unmodeled  state  variables  in  the  measurement 
process.  This  phenomena  only  illustrates  the  coaplexlty  end  surprises  that 
await  the  investigator. 

The  degree  of  improvement  for  the  Autofocue/Conpass  combination 
for  the  t  >  o  slow  climb  trajectory  interval  can  be  expressed*  ea  in 
section  E,  by  the  6  mean  percentage  values  of  the  first  six  variables  given 
as  (11,  11,  115,  21,  16,  116)  in  Table  B2.  Despite  the  unknown  Vf 
component,  the  Compass  measurement  significantly  improves  the  update 
because  its  measurement  plane  in  this  particular  flight  Interval  is  nearly 
at  right  angles  to  the  Autofocus  measurement  plane  and  the  region  of 
intersection  is  less  sensitive  to  the  unmodeled  truth  state  variables. 

The  value  of  the  Autofocus  measurement  in  this  two  measurement  scheme  can 
be  appreciated  by  the  iucrease  in  velocity  error  vector  in  Table  B3  to 
(34%,  141%,  100%)  when  the  Compass  measurement  alone  is  used.  This 
is  to  be  contrasted  to  the  (11%,  11%,  115%)  velocity  error  for  the 
Autofocus/Conpass  combination. 

The  Addition  of  Doppler  Vertical  Velocity  and  Altimeter  Measurements 

With  the  value  of  supplementary  measurements  established,  a  doppler 
vertical  velocity  measurement  was  added  in  order  to  remove  the  uncertainty 
in  the  last  remaining  velocity  component.  A  significantly  improved 
update  was  obtained  with  the  percentage  means  of  the  first  sii 
variables  given  in  Table  B4  as  (5.46,  7.0,  35,  17,  11,  2)  which  represents 
a  50%  improvement  in  the  position  variables,  a  70%  improvement  in 
altitude,  and  finally  a  33%  improvement  in  V  and  V„  estimation. 


HT  ittiition . 

An  additional  altituda  measurement  was  addad  to  tha  updata 
but,  as  indicatad  in  Tabla  B5,  it  affactad  only  tha  altituda 
variable  itaalf. 

H.  A  Definitive  Statement  of  tha  Valua  of  tha  Autofocus  Measurement  in 
tha  Cantripadal  Modal 

At  this  point  in  tha  raport,  it  is  poaaibla  to  avaluata  tha  true 
valua  of  tha  Autofocua  measurement  -  one  of  the  primary  objectives 
of  the  original  investigation.  The  evaluation  vill  be  ends  by  contrasting 
the  naan  and  standard  deviation  of  the  update  error  for  the  six  observable 
states  over  at  least  20  updates  in  both  the  three  and  four  measurements 
cases.  The  following  Tables  H(a)  and  (b)  condense  the  detailed  data 
available  in  Appendix  B  in  Tables  B4,  B7,  B6,  and  B13 


Without  Autofocus  (X)  With  Autofocus  (X) 


State 

(m;o) 

State 

(m?o) 

1 

(45  *,7.7) 

1 

(5.46;3.66) 

2 

(153;25) 

2 

(7.0;6.81) 

3 

(58;20) 

3 

(35 ; 27) 

4 

(51;25) 

4 

(17 ; 14) 

5 

(134;26) 

5 

(Hi  12) 

6 

(1.10;0.54) 

6 

(1.10 ;0. 54) 

Table  H(a) :  Three  Measurement  Case  (Tables  B4  and  B7) 


Without  Autofocus  (X) 


With  Autofocus  (X) 


State 

State 

(m,o) 

1 

(44;4.2) 

1 

(7.14;3.41) 

2 

(161;19.2) 

2 

(7. 66; 2. 76) 

3 

(2.74;2.74) 

3 

(3.34;  2.57) 

4 

(56 ; 24) 

4 

(17.5;15.9) 

5 

132;32) 

5 

(11.4;12.5) 

6 

2. ;0 . 74) 

6 

(3.3;3.64) 

Table  H(b) : 

Four  Measurement  Case 

(Tables  B6  and  B13) 

It  is  clear 

from  Table  H(a)  and  (b) 

that  the  Auto focus 

(centripedal) 

measurement  Is  a  useful  high  S/N  measurement  and  should  be  considered 
operationally  provided  it  is  supplemented  by  other  measurements. 

I.  The  Effect  of  Varying  Measurement  Time 

The  time  between  updates  was  determined  largely  by  the  aperture 
times  of  the  imaging  radar  Autofocus  measurement.  Typically,  these 
times  can  range  anywhere  from  1  to  20  seconds  in  length  with  8 
sec.  being  used  for  the  great  majority  of  runs  in  this  project. 

In  order  to  investigate  the  sensitivity  of  update  accuracy 
to  aperture  time,  a  number  of  runs  were  made  at  update  intervals 
of  4  and  16  seconds  respectively.  Referring  to  Tables  B8  and  B9, 
the  mean  value  of  the  respective  velocity  component  error  ate  (12, 

10,  1.12)  and  (18,  12,  1.09)  for  the  4  and  16  second  three  measurement 
case  respectively.  It  is  apparent  the  system  dynamics  is  highly 
correlated  over  a  20  sec.  interval  and  that  little  independent 
information  is  added  at  the  higher  update  rate. 
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III.  New  Results 

A.  General  Remarks 

Because  the  measurements  considered  in  this  work  were  uniformly 
high  S/N  ratio  measurements,  it  was  natural  to  consider  the  state- 
error  vector  as  a  point  contained  to  an  n-dimensional  plane  defined 
by  the  following  equation, 

(Measurement)  ■  S  •  ■  h^6x^  +  h^fiXg  +  ***  +  hN5xN  (5> 

with  9  «  [L,i  l,i  •  • ,  h  ]  equalling  the  measurement  vector  or  single- 
row  matrix.  This  interpretation  of  the  scaler  measurement  led  naturally 
to  a  geometrical  interpretation  of  the  entire  system  update  mechanism. 

In  particular,  the  propagating  covariance  matrix,  P^,  was  diagonalized 
by  the  IMSL  routine,  EIGRF,  and  the  eigenvalues/eigenvectors  of  P^ 
printed  out.  Using  the  concepts  of  principal  component  analysis  in 
multivariate  statistics,  the  eigenvalues  were  interpreted  as  levels 
of  uncertainty  associated  with  a  particular  eigenvector  direction. 
Geometrically,  the  diagonalization  defines  an  n-dimension  error 
ellipsoid,  whose  relative  orientation  with  respect  to  the  measurement 
vector,  H,  will  completely  define  the  nature  and  value  of  the  update. 

The  interpretation  of  the  update  as  an  orienting  of  the  measurement 
plane  with  respect  to  the  covariance  ellipsoid  will  constitute  the 
remainder  of  this  section. 

B.  Diagonalization  and  the  Forming  of  cos(8)  Between  and  the 
P^  Eigenvectors 

The  covariance  matrix  was,  from  the  beginning,  a  routine 
printout  in  the  SOFE  extended  kalman  filter  simulation.  Not  a 


great  deal  of  attention  was  paid  to  until  the  supplementary 
measurements  were  added  to  the  basic  Autofocus  measurement  around 
January  of  1983.  Because  of  the  noticeable  improvement  when  additional 
measurements  were  added,  the  covariance  matrix,  P^,  was  printed  out 
after  each  of  the  M  measurements  instead  of  simply  at  the  end  of  the 
-complete  update  as  before.  Unfortunately,  the  P^  matrix  as  a  full 
matrix,  is  diff icult^to^  interpret ;  therefore  the  correlation  matrix 
was  also  formed  and  printed  out.  However,  the  correlation  matrix, 
although  normalized,  is  still  a  full  matrix  and  does  not  clearly  portray 
the  independencies  or  cross  correlations  between  the  state-variables.  It 
was  at  this  point  that  the  decision  to  diagonalize  Pf  was  made.  It 
was  the  result  both  of  the  experience  gained  with  the  EIGRF  routine 
and  also  from  the  image  compression  background  of  the  author  wherein 
the  K-L  or  karhuen-Loeve  transformation  is  routinely  used  to  compress 
images.  It  was  later  discovered  that  the  diagonalization  of  P^  approach 
was  really  equivalent  to  the  principal  component  approach  in  multivariate 
statistics  which  had  been  developed  some  twenty  years  ago  by  Pearson 
and  Hotelling.  Briefly  stated,  the  diagonalization  of  the  real  symmetric 
matrix,  P^,  produces  real  eigenvalues  along  with  a  set  of  orthogonal 
eigenvectors  with  real  components.  Each  eigenvalue  represents  the 
variance  or  uncertainty  associated  with  the  direction  of  its  particular 
eigenvector.  The  sum  of  the  eigenvalues  will  represent  the  total 
variance  or  uncertainty  of  the  filter  model  at  some  point  in  the  update. 
One  very  significant  advantage  of  the  diagonalization  lies  in  the 
ability  to  associate  levels  of  variance  or  uncertainty  with  certain 
state  variables  by  simply  observing  their  normalized  component  values 
in  those  eigenvectors  associated  with  the  significant  eigenvalues. 


From  equation  (5),  the  measurement  plane  can  be  interpreted  as 

a  plane  perpendicular  to  the  measurement  vector  defined  as  (h^,  h„ , 

0,  0,  0,  hR).  Intuitively,  it  would  seeir  that  the  Kalman  update  would 

attempt  to  make  the  P^  eigenvectors  lie  within  the  measurement  plane 

after  update  in  order  to  ensure  that  a  particular  scaler  measurement 

could  contribute  (or  project)  no  further  information  to  the  filter. 

Such  a  geometric  condition  can  be  expressed  succinctly  as 

H  •  *  0;  k  -  1,  2,  *••,  n  where  Pfc  is  the  kth  eigenvector  of  Pf, 

(3) 

the  before  update.  Gelb  illustrates  the  geometric  interpretation 
or  the  updates  for  the  simple  two  state  case  shown  in  Figure  1.  In 
this  case,  the  measurement  of  intersects  the  eigenvector  or  major 
axis  of  the  covariance  ellipse  to  give  a  projected  or  estimated  value  of 
xj .  The  covariance  of  the  ellipse  provides  the  correlation  or  best 
linear  estimate  of  x^  by  using  the  correlation  between  x^  and  to 
reduce  to  state-error  variables  from  two  to  one  thereby  reducing  the 
overall  measurement  to  a  completely  determined  problem.  Considering  the 
measurement,  y^,  as  z,  the  best  estimate  x£,  is  equal  to  z  tan (6)  or 


z  In  this  case,  the  measurement  matrix  equals  (1,0)  since  y  is 

y  *  z  *  constant  and  is  perpendicular  to  the  y  -  axis;  it  follows  that 

,(x) 


XX(H  *  Px) 


^  cos(e)  and  X^P^  *  where  is  the  x-axis 


projection  of  the  normalized  P^  vector  which  then  suggests  the  following 

A 

expression  for  x^; 


X,P. 


(x) 


x'  -  .  11  - 
1  X1(?1»H) 


z  P(x) 

1  _ ain(9)  . 

TiyH)  ztan(0) 


(6) 


as  before. 


Because  of  the  intuitive  appeal  of  the  (H  •  P.  )  value,  the  cosine  of 

(H  *  V 

the  angle  or -  was  printed  out  for  k»  1,2,3,  n.  As 

A'-iKl 


expected,  the  update  tended  to  drive  all  (H  •  P.  )  to  zero  as  has, 
in  fact*  been  confirmed  by  every  simulation  run.  This  is  by  itself 
a  useful  result  that  will  be  used  to  define  practical  indexes  of 
measurement  performance  in  Section  D. 

The  next  section  will  restate  the  Kalman  update  equations  in 
terras  of  the  eigenvalues/eigenvectors  of  P^.  The  series  of  derivations 
will  reinforce  the  significance  of  the  (H  •  P  )  measure  and  will 
represent  the  key  analytical  result  of  the  project. 

D •  The  Kalman  Update  Equation  Expressed  in  Terms  of  the 
Elgenvalues/Eigenvoctors  of 
1.  General  Remarks 

In  this  section*  the  Kalman  update  equations  will  be  restated 
in  terms  of  the  eigenvalue/eigenvector  of  the  covariance  matrix 
before  update.  The  notation  will  represent  quantities  before 
update  with  the  superscript  -  and  quantities  after  update  with 
the  superscript  +,  The  update  equation  considered  are  the  following: 

a.  State  Error  Vector  Update 

X+  -  X"  +  K(Z  -  HX~) 

where  the  essential  gain  vector,  K,  is  given  as 

K  ■  P^  HT(H?*HT+Rf)-1  (7) 

where  R^  is  the  measurement  noise  variance  taken  to  be  zero 

under  the  high  S/N  assumption. 

b.  Covariance  Update 


(8) 


In  the  following  de rivet ions,  the  quantities  are  usually 


and  then  finally 


Denom.  r  .  /T, 

_  ■  )  X.  (P.  *H) 

Term  ,  k  -k 
k"l 


(12) 


which  is  an  important  result. 

The  Covariance  Update 

From  the  sftcond  distributive  law  of  matrix  mult iplicat ion , 

Pf  "  Pf  "  KHPf  can  be  exPre88e<i  88  Pf  “  (I-KH)P“  where  1  is 
the  identity  matrix.  One  measure  of  a  good  update  is  the  decrease 
of  the  (i,i)  entry  of  the  P*  matrix  or,  equivalently,  the  degree 
to  which  (KH)j^  approaches  I.  It  is  therefore  the  product, 

KH,  that  is  of  interest  and  which  can  be  expressed  as 


KH 


T 

PflTH 


l  \<4  *hv 

k-i  ^ 


The  term,  PfH  H,  can  be  written  in  terms  of  X^P.^  as 


(13) 


pfHTH  -  [PHXHP  r 


[h1,h2,*“hn] 


(14) 


which,  after  additional  multiplication,  becomes 


T 

P.HH 


WYr-'-'Vn 


,  _n  ,  _n  ,  _n 
^X1P1,X2P2,*.*,XnPn 


(Px  ‘H)^ ,  (Px  -H)h2 ,  •  •  • ,  (Px  -H)hn 
(P2  *H)h^» • • • , 

e 

(^  •H)h1 ,  (Pn  -H)h2 ,  •  •  • ,  (Pn  -H)h 


which  gives  the  following  complicated  expression  for  the  general 
(i,j)  -mtry  of  KHs 


(KH) 


h3  j/vixik-  H> 

iJ  "  n  2 

l  WH> 

K*1 


(16) 


For  the  special  case  of  i  ■  j  ■  1,  we  can  evaluate  (16)  for 
the  one  and  two  component  measurement  as  follows: 
a.  One  Variable  Case:  H  ■  (h^.0,0, • • • ,0) 


b. 


(17) 


or  a  perfect  update  as  expected.  [Note  that  P^H 
Two  Variable  Case:  H  *  (h^,  0,  0,  •  0) 

In  this  case,  the  (KH)^  and  (KH)22  entries 


become : 


(KH) 


hl{ X1P1 (Plhl+Plh2)+X2P2 (P2hi+P2h2) } 


11  x1(p1-h)2+x2(p2-h)2 


P 


(18) 


and 


(KH) 


h2( X:P2 (pJh1+P2h2)+X2P2 (P2h1+P2h2) } 


22 


Xl(-l’H)  +X2(P2 


H)' 


(19) 


Although  the  expressions  are  complicated,  they  do  Indicate 
that  the  more  significant  are  the  values  of  (P^*H)  and 


(P^ «h)  the  more  orthoganal  are  the  measurement  plane 
and  Pf  eigenvector a  and  the  greater  the  resulting  change 
or  update  in  the  covariance  entry.  It  is  noticed  that 
if  x^j-H)2  in  much  greater  than  then  the 

following  approximation  can  be  made: 


plVPlh2 


PlVPlh2 


which  varies  the  quality  update  between  variables  1 

1  2 

and  2  according  to  the  relative  values  of  Pjhj^  and  Pjh2. 

The  State-Error  Update 

The  actual  error  update  vector  is  given  as 


6x  -  KZ 


T 

<PfHT) 

l  MV11)5 

k-l 


which  reduces  to 


-  [PH^lfP!  •  » 


l  W1 

P  •  H  k-l  K 

L“ n  J 


■  DaH 


.  ^  Vk(VH) 

K-l 


l  X.(P.  «H); 


which  Is  a  new  and  useful  way  of  looking  at  the  gain  vector! 

X.  If  P^H  =  1  for  some  subset  of  k,  then  the  update  of  6xx 
will  be  proportional  to  the  of  the  subset  and  the  degree 
of  nonorfhoganality  between  and  H.  Let  us  assume  for  the  sake 
of  argument  that  the  subset  of  V  has  only  one  significant 
k  called  k  [high  X^(Pp»l!)];  the  update  for  dx^  can  then  be 
expressed  as 

pi  2 

*xi  ’  a£:H)  (25) 

which  tends  to  favor  those  state  variables,  with  a  high 
P*  value.  This  measure  will  be  explored  along  with  others 
in  the  next  section. 

Performance  Measures 
1.  General  Remarks 

The  present  section  develops  some  potentially  useful 
performance  measures  for  the  Kalman  filter  update  based  on 
a  diagonalization  or  principal  component  analysis  of  the 
covariance  matrix.  According  to  Hotelling^,  Morrison^, 


et  al.;  the  eigenvalues  of  the  covariance  represent  the  entropy 
or  uncertainty  of  the  filter  model  with  respect  to  the  particular 


eigenvector  associated  with  that  eigenvalue.  With  respect  to 
a  given  eigenvector,  P, ,  It  is  desirable  to  have  the  measurement  plane 
as  nearly  perpendicular  to  P^  In  n-apace  as  is  possible;  for  er.ample, 
if  the  filter  had  a  large  uncertainty  in  the  x-direction,  a  measurement 
perpendicular  to  the  x-axls  would  completely  remove  the  uncertainty 
in  x.  In  general,  it  follows  that  a  measurement 

(Pj-H) 

where  cos(X  )  *  ■  —  is  near  unity  represents  a  measurement 

1  iHlISj I 

where  an  uncertainty  level  equal  to  the  eigenvalue,  can  be 
removed  from  the  filter  according  to  a  measurement  defined  by  the 

component  values  of  the  normalised  eigenvector,  P^. 

Geometric  Interpretation  of  the  Kalman  Update 

The  variation  of  the  eigenvalue/eigenvector  structure  of 

P~  will  now  he  described  for  thte  three  measurement  case  (Table 

B4  of  Appendix  B)  consisting  of  a  compass  measurement,  an  Autofocus 

measurement,  and  a  doppler  vertical  velocity  measurement.  Because 

of  the  linearised,  extended  Kalman  filter  assumption,  the  order 

of  the  measurement  sequence  is  irrelevant.  The  update  time,  for 

no  particular  reason,  is  chosen  at  3.2  minutes  into  the  trajectory. 

Only  five  eigenvalues  of  P~  before  update  are  significant;  they 

4  3 

are  listed  in  order  of  magnitude  as  7.7  x  10  ,  8.8  x  10  ,  2.6 
3  3  3 

x  10  ,  2.6  x  10  ,  and  1.1  x  10  respectively.  According  to  its 
eigenvector,  the  largest  eigenvalue,  7.7  x  10  ,  represents  uncertainty 
primarily  in  the  altitude  variable,  the  vertical  velocity,  and  in 
the  strongly  correlated  barameter  altimeter  bias  variable.  Sluce  this 
eigenvalue  does  not  express  filter  uncertainty  concerning  the  velocity 
vector,  it  would  be  expected  that  the  cos  (a^)  value  associated  wif;h  the 
Compass  velocity  update  would  be  small  as  in  fact  it  is  with  a 


value  of  only  2.29  x  10  \  Only  two  eigenvalues , 


3  3 

•  2.56  x  10  and  X^  ■  2.55  x  10  ,  have  significant  eigenvector 
components  corresponding  to  the  components  of  the  velocity  vector. 

The  cos(ct)  associated  with  these  X  are  0.976  and  0.216  respectively 
which  suggests*  from  the  above  discussion*  that  the  optimum  least 
squares  Kalman  update  will  primarily  reduce  the  eigenvalue 
uncertainty  associated  with  the  cos(a)  •  0.976  update;  this*  in  fact* 
occurs  with  the  updated  P^»  after  compass  update*  possessing  only 
four  rather  than  five  significant  eigenvalues  with  the  X^  eigenvalue  no 
longer  appearing.  In  qualitative  terms  the  update  has  absorbed 
into  the  filter  that  information  corresponding  to  the  (X^P^) 
eigenvalue /eigenvector  pair.  The  other  eigenvalue /eigenvector 
palts  are  not  significantly  effected  by  the  Conpass  update  since 
their  respective  vectors  are  nearly  colllnear  with  the  compass 
measurement  plane. 

The  second  measurement*  Autofocus,  has  its  measurenmnt  plane 

orthogonal  to  the  eigenvector,  P2*  with  an  eigenvalue  weighting 
3 

of  X2  «  2.56  x  10  .  After  the  Autofocus  update,  the  X,  eigenvalue 
has  been  reduced  to  aero  and  is  no  longer  significant.  Since 
the  sum  of  the  eigenvalues  equals  the  trace  of  the  covariance 
matrix  or  the  uncertainty  level  of  the  filter,  it  follows  that 
each  measurement  will  remove  a  level  of  uncertainty  proportional 
to  the  eigenvalue  corresponding  to  a  high  H*?^. 

The  doppler  vertical  veloci  y  measurement  is  the  third  and 
final  measurement.  The  doppler  measurement  row  vector 
(0, 0.0, 0,0, 1*0,  ‘“.O)  was  found  to  have  significant  values 


\ 


LI  .  .m. 


of  (0.12,0.18,0.96)  with  respect  to  the  firet  three  eigenvectors 

of  the  updated  Pf  matrix .  The  V2or  doppler  measurement  is  especially 

significant  for  velocity  vector  update  since  one  of  the  high 

a 

H-P,  eigenvectors  is  associated  with  the  largest  (7.6mlO  )  eigenvalue 
and  has  significant  XjP^  values  for  the  j  -  4,5,6  components 
of  the  velocity  vocotr.  Accordingly,  it  would  be  expected  that 
the  addition  of  the  doppler  update  would  significantly  improve 
the  velocity  update.  This  update  enhancement  has  been  observed 
repeatedly  during  the  simulation  runs. 

3.  Performance  Measure  for  the  Velocity  Vecotr  Update 

It  is  worthwhile  at  this  point  to  remind  the  reader  of  the 
overall  project  objective.  Referring  to  Appendix  A,  the  original 
project  intent  was  to  consider  the  use  of  the  Autofocus  measurement 
as  a  way  of  updating  an  INS  navigation  system  in  order  to  accurately 
estimate  the  velocity  vector  as  a  means  of  extending  the  "lock- 
in"  time  for  the  Autofocus  algorithm.  (See  Appendix  A) 

Considering  the  diagonal izat ion  of  ,  it  is  clear  from  the 
above  discussion  that  the  degree  of  filter  uncertainty  about  a 
given  state  variable  i  can  be  expressed  as  R^  where 

<2« 

k«l 

and  n  equals  the  order  of  the  filter  while  p£  is  the  ith  component 
of  the  normalised  kth  eigenvector  (see  Morrison  [6]).  It  would 
seem  reasonable  to  expect  that  any  useful  measurement  of  the  i^1 
variable  would  result  in  a  decrease  in  R^  with  the  relative  change 
in  expressing  the  relative  effectiveness  of  the  measurement. 
Furthermore,  after  a  series  of  measurements,  the  dominant  X^p£ 


of  the  final  will  indicate,  by  the  significant  consonant a  of 
(ft  -  1, • • • »N) ,  how  an  additional  aeasuresmnt  should  ba  da signed 
in  order  to  improve  the  filters  knowledge  of  the  1C^  variable. 

As  an  exaople  of  the  nonotonic  decrease  in  with  each  auccessive 
update,  consider  the  R^  for  the  6  observable  variables  over  the 
three  measurements;  compass ,  Autofocus,  and  vertical  velocity. 


Before 

Update 

Compass 

Alone 

Autofocus 

an<J 

Compass 

Compass i  Autofocus; 
and  Doppler 

Longitude 

6.71xl0-4 

3.71xlO“4 

1.70xl0“4 

3.97xl0~7 

Latitude 

5.81xl0-4 

4.44xl0-4 

2 .04xl0~4 

1.34xl0“6 

Altitude 

7.68xl04 

7.5xl04 

7.39xl04 

4 . 34xl04 

East 

Velocity 

1.95xl03 

l.OOxlO3 

4.93xl02 

4.34xl0~7 

North 

Velocity 

3.05xl03 

2 . 32xl03 

1.06xl03 

9.37xl0~7 

Vertical 
Veloc ity 

1.22xl04 

6.79xl03 

6.52xl03 

5.59xl0“6 

TABLE  El:  Evaluation  of  R^:t  ■  192  sec. 

Strictly  from  an  information  content  point  of  view,  the  great  reduction  in 
R^  for  the  longtiude,  latitude,  and  velocity  vector  components 
indicates  that  the  filter  has  confidence  in  its  knowledge  of  these 
variables.  Only  the  altitude  variable  retains  a  high  R^  which 
suggests  that  this  variable  is  really  uncoupled  from  the  other 
variables  and  can  be  updated  without  any  interaction  with  the 

other  variables.  Furthermore,  collapsing  values  of  R^  indicate 
that  any  update  error  after  the  three  measurements  is  th«  result 


of  either  unmodeled  truth  state  \ariables  or  measurement  noise  J 

it  is  not  the  result  of  filter  uncertainty. 

Perhaps  the  greatest  value  of  the  R^  measure  lies  in  the 

insight  it  provides  for  the  design  of  the  overall  measurement 

strategy.  Let  us  suppose  that  we  wish  to  design  a  series  of 

measurements  that  will  accurately  estimate  the  velocity  vector. 

Before  any  measurement  occurs  at  t  *  3.2  minutes  into  the  flight, 

the  for  the  three  velocity  components  are  given  as  follows: 

3  3  4 

(R^  *  1.95x10  ;  R  *=  3.05x10  •  Rg  ■  1.22x10  ).  From  inspection, 

it  is  determined  that  the  eigenvalues  contribute 

X3P36+X4P4  "  1-95xl°3*  X3P3+X4P4  “  3-05xl°3*  X3P3+X4P4  "  0,28  t0  the 
values  of  R.  ,R,.,R,  respectively.  In  other  words,  the  (P.,P,) 

eigenvectors  represent  essentially  the  entire  filter  uncertainty 

at  this  stage  of  the  update.  The  first  six  observable  components 

are  given  for  P^  and  P^  as  follows: 

P3  *  (3.3xl0“6,4.00xl0"8,-2.14xl0"6,  0.977,0.21j.  2. 14x10~4,« • • ) 

and 

P^  *  (-7.4x10_8,1.8x10~6,9.6x10~6,  -0.215.0.977.  -1.03xl(f  V  *  *  ) 

It  is  clear  that  a  measurement  involving  only  the  Vg,VN  velocity 

components  would  remove  a  significant  amount  of  uncertainty  concerning 

the  V„,V„  components;  the  Compass  measurement  is  one  such  candidate 
E  N 

measurement.  After  the  Compass  measurement,  the  P2  eigenvector 
of  the  new  Pf  matrix  represents  virtually  all  the  value  for 
both  the  east  and  north  velocity  components  at  this  point  in  the 
update  process.  The  new  P^  after  Compass  update  is  given  as  follows: 


P2  -  (1.45xl0~7,1.73xl0_7,9.86xl0~6,  .421,  .907,  1.47xl0~4,  •  •■•) . 

4  5 

A  simple  calculation  verifies  that  X2P2  and  X2P2  represent  nearly 
100%  of  the  R^,  R^  values  at  this  point  in  the  update.  The  high 
values  of  P4  and  P3  suggest  that  another  (VE»V^)  coupled  measurement 
is  indicated;  namely,  the  Autofocus  measurement.  The  principal 
uncertainty  in  the  third  velocity  component,  V^,  however  resides  in  the 
P^  eigenvector  which  is  associated  with  the  largest  eigenvalue, 
the  JP^  eigenvector  is  given  as 

P:  -  (-5 . 29xl0~ 12 , -2 .OexlO"11 ,-0.981,4. 33xl0~6 , -9 . 3xlO~6 , - . 123 , * • Q 

(29) 

which  indicates  that  only  an  altitude  or  a  direct  measurement 
can  remove  the  uncertainty  in  V^. 

After  the  Autofocus  measurement  has  been  completed,  there 
are  still  significant  values  of  R^,  R^,  R^  which  now  reside  almost 
entirely  in  the  new  eigenvector  given  as 

Px  =  (3xl0~8 , -3xl0~9 ,-0.98,  9.1xl0~3,1.9xl0~2,-0.121, • • •)  (30) 

Because  of  the  large  values  of  the  altitude  and  V  components 
in  the  normalized  P^,  it  would  seem  possible  to  remove  the  remaining 
uncertainty  in  the  velocity  vector  by  either  a  direct  altitude 

or  measurement.  Taking  the  third  measurement  as  a  direct  altitude 
measurement  (Table(B12)),  the  R^,  R,. ,  values  are  reduced  to  (77.8, 

168,  1030.)  respectively  which  represent  a  decrease  in  the  R^  values 
of  (96.1%,  94.5%,  92,5%)  which  constitutes  a  good  update.  The 
simulation  confirms  this  conclusion  with  the  excellent  velocity 


vector  mean  error  values  of  (20%,  16%,  33%).  When  the  third  scaler 

measurement  is  a  direct  measurement,  the  R^»  R^»  Rg  valuea 

are  from  Table  (El)  reduced  to  zero.  This  Indicates  that,  within 

the  capabilities  of  the  filter  model,  an  optimum  filter  update  will 

be  realized  by  the  Compass,  Autofocus,  and  measurements;  this 

is  verified  in  Table  (B4)  with  mean  error  values  of  (17%,  11%,  2.22%) 

which  represent  the  best  velocity  vector  update  observed.  The  zero  values 

of  R  ,  R_,  R,  further  suggest  that  no  additional  velocity  update 
4  5  o 

improvement  is  possible  when  a  fourth  altitude  measurement  is 
added.  This  is  confirmed  in  Table  (B5)  with  an  essentially  unchanged 
mean  value  of  (17%,  11%,  3.3%).  As  far  as  the  velocity  vector 
is  concerned,  the  altitude  measurement  is  superfluous. 

The  above  discussion  suggests  the  following  step-by-step 
measurement  strategy: 

1.  Determine  the  significant  A  P*  terms  in  the  R.  values 
of  interest. 

2.  Design  (within  practical  limits)  your  measurement  so 
that  H*Pk  :  1,0  for  the  Important  k  values 

3.  Proceed  until  all  R^  of  interest  are 2  3  0. 

Addition  of  the  Autofocus  Line  of  Sight  Term 

Throughout  the  report,  the  assumption  has  been  made  that 
only  a  centripadal  acceleration  contributes  to  the  quadrative 
phase  error  measured  by  the  A.F.  image  restoration  algorithm. 
Operationally,  this  would  only  apply  to  a  circular  loiter  trajectory. 

For  more  generality,  the  line  of  sight  acceleration  component 
is  added  to  the  measurement  as  given  by  (See  Appendix  A): 


(Additional  _  ..  T  *  «  , 

Tern)  L.O.S.  T  \wL.O.S.  ~  wL.O.Si 


where  Xp*  A  are  the  truu  and  best  estimates  of  the  acceleration 
T 

vector  and  \  o  S  ’  PL  0  S  are  t^ie  true  and  ^est  e*timate8  of 

the  line  of  sight  unit  vector  connecting  the  aircraft  to  the  target 

point.  The  proportionality  constant  1L  equals 

where  X  is  the  wavelength  of  the  radiation.  The  unit  vector 

UT  n  e  can  be  expressed  as 


^L.O.S.  (cosfot+eEJ»  cos[e+eN],  cos[y+ez]) 

where  (a.S.y)  are  the  angles  from  the  aircraft  to  the  target  and 
(eg»  eN»  ez)  are  the  altitude  error  vectors.  Expression 
(32)  now  involves  nine  new  state  variables  including  an  augmented 
delayed  velocity  vector  -aed  to  form  the  acceleration  vector. 

In  the  SOFE  simulation,  the  acceleration  vector  is  formed 


as  follows, 

t.-Vl 


t  t-T 
T 


where  ^t_T  is  the  previous  velocity  stored  in  the  H  Z  routine. 

In  order  to  implement  (33)  and  (32),  the  SOFE  simulation  was  converted 
from  variable  step  to  a  fix  step  integration  with  a  value  T  - 
0.5  seconds  finally  chosen. 

Various  runs  were  made  with  the  L.O.S.  component  in  the  vicinity 


of  t  ■  1000  seconds  or  16  minutes  into  the  flight.  One  outstanding 

change  was  the  number  of  observable  variables  which  increased 

from  6  in  to  centripedal  only  case  to  12  in  the  L.O.S.  case  according 


to  the  inner  product  test;  however,  the  non-zero  inner  products 
were  of  the  order  of  0.2  instead  of  0.7  for  the  previous  case. 

While  this  suggests  a  "broader"  coupling  of  the  Autofocus  measurement 
with  the  state  vector,  it  also  suggests  a  "weaker"  coupling  for 
the  individual  state  variables.  Some  actual  simulation  runs  arc 
given  in  Tables  (B13),  <B14),  and  (B15) ;  they  are  to  be  compared 
to  the  centrifedal'-only  runs  of  Tables  (Bl),  (B2),  and  (B4).  Vhile 
there  are  slight  differences,  it  can  be  concluded  that  the  acuition 
of  the  L.O.S.  term  does  not  in  general  improve  the  velocity  vector 
update.  This  is  not  too  surprising  since  the  addition  of  the 
L.O.S.  term  merely  repositions  the  Autofocus  measurement  plane; 
it  still  remains  a  single,  high  S/N  measurmeent  although  it  does 
involve  the  state  vector  more  intimately. 

During  the  update,  the  L.O.S.  runs  exhibited  the  same  geometric 
behavior  among  Pj  and  H  as  the  centripedal  only  runs  although 
the  uncertainty  in  the  matrix  is  now  distributed  over  8  eigenvectors 
rather  than  5.  As  a  consequence  of  this  dispersion,  each  of  the 
scaler  measurements  remove  a  lower  percentage  amount  of  uncertainty  than 
in  the  centripedal  only  case.  These  conclusions  are  tentative 
however  and  must  await  the  programming  of  the  calculation  and 
the  running  of  L.O.S.  case  over  different  intervals  of  the  trajectory. 
Because  of  major  programming  problems,  these  tests  could  not  be  made 
within  the  contract  time  interval. 


G.  Topics  to  be  Investigated 

The  project  has  suggested  the  following  topics  for  investigation: 

1.  To  put  the  inner  product  test  (Equation  (1))  on  a  firmer 
analytical  foundation.  To  investigate  the  significance  of 
"degree  of  observability"  and  how  it  can  be  used. 

2.  To  complete  the  analysis  and  consideration  of  the  L.O.S. 
Autofocus  mode. 

3.  To  further  develop  the  geometric  interpretation  of  the  high 
S/N  Kalman  update.  To  put  the  performance  measure,  on 

a  stronger  analytical  base  and  to  also  develop  new  performsnee 
measures  for  evaluating  filter  performance. 

4.  To  investigate  the  value  of  the  dlagonallzation  in  the 
prediction  and  avoidance  of  filter  divergence. 

5.  To  consider  systems  triiere  nonobservability  can  be  a  problem 
and  to  consider  how  the  P^  dlagonallzation  may  help  alleviate 
the  problem. 

6.  To  consider  new  applications  and  to  demonstrate  the  value 

of  the  design  philosophy  defined  in  this  report  for  arbitrary 
A  and  H  matrices. 

CONCLUSIONS 

The  conclusions  of  the  project  are  the  following: 

1.  For  the  centripedal  acceleration  case  only,  the  Autofocus 

measurement  proved  to  be  a  useful  measurement  when  supplemented 
by  additional  measurements.  In  particular,  a  Compass,  an 
Autofocus,  and  doppler  velocity  update  realize  better  than 
a  94%  update  quality.  Without  the  Autofocus,  the  quality 
suffers  greatly. 


2.  A  geometric  interpretation  of  the  Kalman  update  was  made. 

It  was  discovered  that  the  relative  orthoganality  (H.pp 
of  the  eigenvectors  of  to  the  rows  of  the  measurement 
matrix,  H>  determine  the  update  mechanisms.  The  Kalman 
update  equations  were  analysed  and  restated  to  reflect  this 
interpretat ion . 

n  . 

3.  A  new  performance  measure,  £  X.P*  -  R.  ,  was  defined  to  reflect 

i-1  1  1  K 

the  relative  uncertainty  of  the  filter  with  regard  to  the 
h*"*1  state  variable.  The  measure,  R^,  was  used  along  with 
a  study  of  (X^.P^)  combinations  in  order  to  define  a  measurement 
design  philosophy. 

4.  The  line  of  sight  (L.O.S.)  term  was  added  to  the  Autofocus 
measurement  and  the  resulting  runs  were  discussed. 
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IMAGING  RADAR  AUTOFOCUS  UPDATE  OF  AN 
INERTIAL  NAVIGATION  STSTEK  BY  MEANS 
OF  A  KALMAN  FILTER 


by 

William  S.  McCormick 

ABSTRACT 

Thr  '  an  Autofocus  update  of  an  INS  la  investigated.  Three 

cases  arc  'd:  (1)  centripedal  acceleration  only;  (2)  centrlpedal 

and  line-.  .  t  acceleration;  and  (3)  centripedal  and  line-of-sight 
acceleration  as  well  as  attitude  error  effects.  The  extended  Kalman  filter 
configuration  was  employed  using  the  versatile  SOFE  Monte  Carlo  simulation 
program.  Measurement  matrices  were  defined  for  each  of  the  three  cases. 
Simulation  results  Indicated  an  observability  problem  for  Case  (1) . 
Suggestion  for  further  work  was  included. 
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X.  INTRODUCTION 

Imaging  radar  (SAR)  hat  bacoma  an  increasingly  important  all  vaathar 
•analog  technique  for  both  raconnaiaaanea  and  weapon  delivery  application*. 
Briefly  stated,  imaging  radar  provide*  high  asiauth  resolution  by  co¬ 
herently  processing  the  naturally  occurring  doppler  return  over  the 
•ynthetic  radar  aperture.  Because  of  the  phtae  coherence  requirement, 
any  phase  error  accumulated  over  the  aperture  time  will  result  in  both  a 
loss  of  resolution  and  a  higher  sldelobe  level.  Under  normal  circum¬ 
stances,  the  radar  processor  will  use  the  dynamic  output  of  the  inertial 
navigation  system  (INS)  to  compensate  for  aperture  phase  perturbations. 
Unfortunately,  a  typical  unaided  INS  system  will  have  an  error  state 
vector  that  Increases  with  time  until  the  imaging  performance  of  the  SAX 
radar  becomes  seriously  degraded. 

In  order  to  correct  for  the  uncompensated  phase  error,  a  number  of 
Iterative  image  restoration  techniques  have  been  developed  under  the 
generic  name  of  "Auto-Focus"  (AF)  techniques.  Although  the  details  of  the 
algorithms  are  propletary,  most  autofocus  techniques  estimate  various 
orders  (e.g.  quadratic,  cubic,  etc.)  of  phase  error  by  measuring  the 
relative  displacement  of  a  point  target  as  processed  in  contiguous  sub¬ 
arrays.  Since  the  AF  techniques  must  attempt  a  location  estimate  of  & 
point  target  end  since  that  target  resolution  is  Itself  degraded  by  the 
phase  error,  it  naturally  follows  that  there  will  be  a  "lock-in"  value 
for  maximum  accumulated  phase  error  that  must  not  be  exceeded  for  success¬ 
ful  autofocus  operation.  However,  since  the  Autc-Focua  algorithm  is 
quite  accurate  and  can  essentially  eliminate  the  phase  error  (provided 
it  is  operating  within  its  "lock-in"  range),  it  could  also  provide  a 
potentially  useful  means  of  updating  the  INS  system  every  aperture  time. 
Assuming  the  AF  scaler  measurement  contains  adequate  information  on  the 
INS  error  state  vector,  it  would  therefore  appear  possible  to  bound  the 
growth  of  the  error  state  vector  by  somehow  Integrating  the  AF  measure¬ 
ment  with  the  INS  system.  Performed  optimally,  such  an  AF  update  could 
well  improve  the  INS-dependent  SAR  processor  to  such  an  extent  that  the 
AF  mission  time  ("lock-in")  is  extended  well  beyond  its  present  limit. 

The  optimal  integration  or  augmentation  of  various  sensors  has 
traditionally  been  performed  using  the  Kalman  filter  algorithm.  Many 


sensor*^  havt  been  considered  for  IMS  augmentation  Including  doppler  radar, 
nonopul position  fixing ,  star-* trackers  and  loran/Onega  type  system. 

Ho  consideration  has,  however,  been  given  to  the  potential  value  of  AY 
algorithm  as  an  IMS  update.  With  regard  to  the  AY-INS  Kalman  filter 
update,  a  nuaber  of  questions  must  be  addressed.  Some  of  these  questions 
are  as  follows: 

(1)  questions  of  observability  or  simply  whether  the  scaler  AY  measure¬ 
ment  contains  enough  information  about  the  IMS  error  state-vector  to 
provide  a  useful  filter  update. 

(2)  given  the  nonlinear  nature  of  the  AY  measurement,  the  effects  of 
trajectory  dependent  nonlinear  noise  must  be  considered. 

(3)  since  the  Kalman  filter  will  have  a  deleted  state  vector,  the  question 
of  filter  convergence  must  be  Investigated  when  the  AY  update  is  used. 

II.  OBJECTIVES  , 

The  principal  objective  of  this  study  was  to  Investigate  the  value  of  an 
"Auto-Focus"  update  of  an  INS  using  the  Kalman  filter  algorithm.  In 
particular,  ay  discussed  in  Section  I,  the  study  will  consider  the  value 
of  the  AY  update  as  a  means  of  extending  the  AY  mission  time  cr,  equiva¬ 
lently,  the  time  before  the  AY  algorithm  loses  lock.  A  detailed 
consideration  of  observability,  the  effects  of  nonlinear  noise  and 
filter  convergence  vill  be  considered  for  the  following  cases: 

Case  A:  In  the  simplest  case,  only  the  centripedal  acceleration  term  is 
considered  as  a  contributor  to  quadratic  phase  error.  This  case 
implicitly  assumes  that  the  velocity  vector  is  constant  which  ic 
clearly  an  oversimplification. since  this  measurement  comprises 
only  one  scaler  measurement  and  involves  only  3  of  the  13  state- 
variables,  the  question  of  observability  is  very  important  in  vhis  case. 
Case  B:  For  this  case,  the  line  of  sight  acceleration  component  is 

Included  as  a  source  of  quadratic  phase  error.  Such  a  measure¬ 
ment  is  still  scaler  and  nonlinear  but  now  involves  9  of  the  13 
state-variables. 

Case  C:  The  attitude  error  states  are  included  in  their  measurement  which 
increases  the  total  number  of  state-variables  involved  in  the 
measurement  to  12. 


Case  D;  Using  the  complete  measurement  of  the  12  state-variable  dependent 
AF  update  of  Case  C,  an  investigation  will  be  made  into  the  per¬ 
formance  degradation  suffered  by  the  Kalman  filter  when  its  measure¬ 
ment  matrix  is  defined  by  the  more  computationally  efficient 
assumptions  of  Cases  A  and  B. 


III.  EVALUATION  OF  QUADRATIC  PHASE  ERROR 

As  developed  in  reference  2,  the  RF  phase,  *f(t),  generated  by  aircraft 
motion  over  the  aperture  time  can  be  represented  in  a  Taylor  series  as, 

f(t)  =  [R(o)  +  [R(t)lt-o  t  +  [R(t)]t=o  |^+  ...  +  (1) 


It  is  assumed  in  this  study  that  the  phase  return  is  predominately  low-frequency 
in  origin  and  can  be  approximated  well  by  neglecting  third  and  higher  order  terms 
from  (1);  that  is,  the  phase  variation,  'f(t),  varies  quadratically  with  time. 

With  reference  to  the  autofocus  measurement,  the  phase  error  can  be  expressed 
directly  as, 
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where  the  subscript  T  represents  true  value  and  the  subscript  E  represents 
estimated  value.  After  every  aperture  interval,  T,  the  autofocus  algorithm 
provides  an  estimate  of  the  quadratic  error  term  given  by 
Auto  focus  f,_\  ..  „2 
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Referring  the  differential  diagram  of  Figure  1,  we  can  write 


dR  =  -  dx  cos  0 
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or 
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or,  after  differentiating  a  second  time. 
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which  can  be  recognized  as  the  sun  of  a  centripedal  tern  and  a  line  of  sight 
term.  The  autofocus  output  can  then  be  expressed  in  terms  of  (lb)  and  (3)  as 
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where  p£os»  y£os  are  t*le  true  an<*  estimated  unit  line  of  sight  vector.  The 

unit  vector,  p  nc,  points  from  the  aircraft  to  the  target  and  has  direction 
LUb  2  2 

cosines  defined  in  the  geographical  frame.  The  terms  V_,  V_,,  represent  the 

magnitude  squared  of  the  true  and  estimated  velocities  respectively. 


In  the  study,  the  assumption  is  also  made  that  the  antenna  phase  center 
is  ce'ncident  with  the  body  centroid  of  the  aircraft.  This  assumption  merely 
neglects  the  lever  arm  effects  between  phase  center  and  body  center  and  is 
quite  reasonable  physically;  it  also  offers  a  considerable  simplification 
since  it  essentially  equates  the  aircraft  (INS)  and  antenna  reference  systems. 


IV.  THE  EXTENDED  KALMAN  FILTER 

A  voluminous  literature  exists  on  the  Kalman  filter.  Basically,  it  is  a  mini¬ 
mum  variance,  recursive  estimator  that  generates  the  optimum  conditional 
mean  estimate.  In  the  usual  continuous-discrete  measurement  form,  the' 
linear  Kalman  filter  propagates  the  estimate,  ft(t),  and  covariance,  P^(t), 
according  to  the  dynamic  equations, 

j^Ct)  -  F(t)  if(t)  (5) 

and 

Pf(t)  -  F(t)  Pf(t)  +  Pf(t)  FT(t)  +  Qf(t)  (6) 

where  F(t),  Q^(t)  are  the  filter  dynamics  and  input  noise  levels  respectively.  • 
At  measurement  time,  the  filter  weights  the  new  measurement  according  to  its 
signal  to  noise  properties  and  by  the  current  state  of  knowledge  of  the  state 
vector  as  expressed  by  the  propagated  covariance,  P^(t).  The  measurement 
and  update  operations  are  defined  by  the  gain  matrix,  K,  as  follows: 


K  -  P~  H1  tH  Pf  HT  +  Rf I"1 

(7) 

*4-  ~  A_ 

• 

Xf  -  Xf  +  K  [Zs  -  H  Xf] 

(8) 

4- 

Pf  “  Pf  -  K  H  Pf 

(9) 

where  H  is  the  measurement  sensitivity  matrix,  is  the  measurement  noise 

covariance,  and  Z  is  the  measurement  itself, 
s 

Since  both  the  INS  dynamics  and  the  autofocus  measurements  are  highly 
nonlinear,  the  above  linear  Kalman  filter  cannot  be  directly  applied  in  the 
form  of  equation  5  through  9.  Rather,  the  extended  Kalman  filter  is  used 
where  the  F(t),  H(t)  are  now  linearized  about  some  estimated  trajectory  as, 
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Figure  2  illustrates  the  extended  Kalaan  filter  configuration. 

Although  Figure  2  represents  the  usual  or  direct  configuration,  it  is 
not  an  attractive  configuration  for  INS  applications  because  of  the  high 
computational  requirements  Involved  in  propagating  the  full  vector  estimate, 

A 

X^t).  The  indirect  or  error-state  vector  configuration  is  the  approach 
normally  used.  This  approach  propagates  the  nonlinear,  dynamic  equation, 
f(Xf;t),  by  linearizing  about  the  trajectory  as  is  already  done  with  the 
covariance  propagation.  The  time  variation  of  the  error  state-vector  is 
much  slower  than  the  full  state  vector  which  therefore  permits  real  time 
operation. 


V.  THE  KALMAN  FILTER  SIMULATION  USING  "SOFE"  WITH  THE  LK-15  IKS  DYNAMICS 
In  order  to  study  the  effectiveness  and  sensitivity  of  the  nonlinear 
Kalman  filter,  a  Monte  Carlo  simulation  is  usually  performed.  In  such  a 
simulation,  the  actual  measurement  is  generated  by  what  is  referred  to  as 
the  "truth"  model  which  is  simply  a  higher  order  model  of  the  particular 
INS  under  investigation.  For  the.  sake  of  the  simulation,  the  "truth"  error 
state-vector,  X  (t) ,  is  considered  as  the  actual  error-vector  which  then 
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allows  the  best  Kalman  estimate  to  be  written  directly  as  "true"  +  X^t)  ~ 
X^t)' where  the  "true"  trajectory  is  a  tape  input  corresponding  to  some 
maneuver.  The  measurement  is  now  written  as 

Measuremc-.t  -  (TRUE  -  PREDICTED)  +  NOISE  (12) 

where  the  TRUE  corresponds  to  the  nonlinear  neasurement  as  given  by  the 

trajectory  values  and  the  PREDICTED  is  the  nonlinear  measurement  as  given 

by  the  best  Kalman  filter  estimate,  "True"  +  X  (t)  -  X.(t).  The  noise  is 

■  —  — r 

white,  Gaussian  measurement  noise  with  a  covariance  of  R^. 

During  the  study,  the  versatile  Monte  Carlo  simulation  program  called 
SOFE  was  used  exclusively.  This  program  was  written  by  Mr.  Stanton  Musick 
cf  the  WPAFB  Avionics  Lab  and  features  a  variable  -5-  step  integration  sub¬ 
routine  and  the  Carlson  sequential  square  root  matrix  inversion  routine  for 
Kalnan  filter  gain,  K,  calculation. 


The  INS  model  chosen  was  Che  local-level  Honeywell  LN-15  system  defined 
as  a  1  n.m. /hr. system.  As  listed  In  Appendix  1,  the  "truth"  model  has  47 
state  variables  and  the  filter  model  has  15  state  variables. 


VI.  OBSERVABILITY  TEST 

Since  the  update  on  measurement  constitutes  an  attempt  to  update  a  13 
state  vector  with  a  single  scaler  measurement,  the  question  of  observability 
becomes  important.  In  the  problem  at  hand,  the  question  can  be  phrased  as 
follows:  "Is  the  implicit  coupling  of  velocity,  acceleration,  and  attitude 
components  as  contained  in  the  LN-15  dynamics  equations  sufficient  to  allow 
the  Kalman  filter  to  update  each  vector  component  in  the  proper  proportion." 

As  developed  in  reference  5,  a  measurement  can  be  shown  to  be  observable 
if  the  following  observability  matrix,  4,  is  invertible; 


-  [>:  ?T  ht:  (fV  hti  ... !  (F’f1  / 

Li:  :  :  J 


the  matrix  is  a  square  nxn  matrix.  The  degree  of  observability  of  the  measure¬ 
ment  can  be  quantified  by  the  condition  number,  C,  of  4  defined  as 

„  Determinant  of  4  ,, 

iRi  w> 


VII.  THE  MEASUREMENT  AND  H  MATRICES  FOR  CASES  A,B«  AND  C 
Case  A:  Centiipedal  Acceleration  Only 

■Referring  to  Section  III,  the  measurement  can  be  written  directly  as 

kcent  [(\2  +  VI2  +  VI  >  -  <*.  *  ;2  +  v2>]  -  VV*  -  VV>  w> 
(.  e  n  z  ~  ~ 

where  (V^.  ,  V^  ,  )  is  the  time  velocity  vector  cf  the  tape  trajectory  and 

e  n  * 

(Vg,  V  ,  V^)  is  the  best  estimate  of  velocity  given  by 


Ve  -  VT  +  XS(4)  -  XF(4) 


Vn  “  VTn  +  XS(5)  -  XF(5) 


-  VT  +  XS(6)  -  XF(6) 


with  K, 


2  2 
4tt  sin  6  T 


where  the  first  order  perturbation  of  (13)  yields  the  H  matrix  given  as 
H(4)  -  °hf(  )  I  -  -  2Kr,_u_  V  -  -  (Vw  +  XS(4)  -  XF(4)) 
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In  this  case,  the  nonlinear  noise  is  only  second  order  and  has  an  explicit 
expression,  R^,  given  as 

RA  “  KCENT  {<“<*>  “  ®<*»2  +  <»(5)  -  XF(5))2  +  (XS(6)  -  XF(6))2]  (18) 


Case  B:  With  Line  of  Sight  But  Without  the  Attitude  Error 

Referring  again  to  Section  III,  the  measurement  term  Includes  Case  A  plus 
the  nonlinear  term  due  to  the  line  of  sight  acceleration  given  in  (4)  as 


■> 


*1.0.8.  tAT  '  UL.O.S.  “  A  '  “L.O.S.* 

',here  *i.o.s.  ■ 

This  can  be  expanded  as 
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-  A  cos  a  -  A  cos  B  -  A  cos  y)  ■  h  (  )  -  h.(  )  (19b) 

e  n  z  sr 

A  A  ^ 

where  (cos  u^,  cos  cos  y j)  and  (cos  a,  cos  B,  cos  )  are  the  true  and 
estimated  direction  cosines  of  the  unit  vector  between  the  target  and  the  phase 
center  and  ^A  are  the  true  and  estimated  values  of  acceleration.  All  the 
quantities  of  expression  (19b)  are  referenced  to  the  geographical  system. 

Since  the  LN-15  IMS  dynamic  equations  are  basically  second  order  (Newton's 
second  law),  the  acceleration  state  vector  is  implicit  and  can  be  generated 
dynamically  as  follow 

where  $(t-T)  is  the  velocity  vector  at  the  end  of  the  previous  integration 


(20) 


interval  and  r  is  the  sice  of  the  Integration  interval.  The  acceleration 
vector  is  augmented  as  XF(14),  XP(15),  X(16)  respectively.  The  true  and 
estimated  values  of  the  direction  cosines  are  calculated  in  the  geographic 
system  from  the  true  and  estimated  coordinates  of  the  aircraft  position 
relative  to  the  fixed  point  target  being  Imaged.  The  equations  are  straight¬ 
forward  and  are  not  included  here. 


The  derivation  of  the  new  entries  of  the  H  matrix  proceeds  from  the 
general  expression  for  H  {t^,  xf}  given  in  (11)  as 


H(t;  xf) 
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where  the  new  h^(  )  function  is  given  by 

hf <*f ;t>  "  *4,  o  S  co8  ^  +  \  COS  ^  +  K  COB  (22) 

which  leads  directly  to  the  following  [H]  matrix  entries  given  as: 
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where 

Ae  -  ^  +  XS(45)  -  XF(14) 
e 

An  -  Kj,  +  XS(46)  -  XF(15)  (24) 

n 

Az  -  A.J.  +  XS(47)  -  XF(16)  . 
z 

In  calculating  the  expressions  of  (19b)  and  (23)  the  geographical  frame  is 
employed  which  requires  a  position  conversion  from  the  earth  frame  (X,L)  to 


(Xe,Xn)  In  Che  geographical  frame;  e.g.  (6a)  geographical  can  be  set  equal  to 
R/Rj  (6X)  [Rj  6a  -  R  6X),  with  R  equal  to  the  earth-ellipsoidal  radius  length 
and  R^  equal  to  the  radius  vector  length  from  the  image  point  target  to  the 
antenna  phase  center. 

Vlth  regard  to  expression  (19),  the  inclusion  of  position  error  in  the 

AAA 

form  of  (6a,  63,  6y)  is  a  direct  result  of  the  imaging  radar  application 
where  the  unit  pointing  vector  has  one  end  fixed  at  the  Imaged  point 
throughout  the  entire  aperture  time  while  the  other  vector  end  fluctuates 
according  to  the  uncertainty  of  the  aircraft  position.  Such  a  position 
uncertainty  term  is  not  present  in  the  H-matrix  of  the  doppler-INS  augmenta¬ 
tion  since  the  doppler  measurement  is  not  referenced  to  specific  target 
points;  l.e.  the  unit  vector  merely  slides  along  the  ground  in  a  parallel 
fashion  and  is  not  fixed  at  one  specific  target. 

For  Case  B,  the  nonlinear  noise  term  is  the  sum  of  the  nonlinear  noise 
of  Case  A  and  a  remainder  term  of  the  Taylor . series  expansion  of  expansion 
of  (19)  which  can  be  handled  as  follows 
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where  *  sub?.  tt,  M,  refers  to  the  maximum  value  expected  over  normal 
operation.  inc e  this  term  is  not  known  aprlori,  it  is  Impossible  to 
compensate  for;  however,  under  normal  convergence,  the  nonlinear  noise  is 
expected  to  be  masked  by  measurement  noise. 


VIIL  COMPUTER  RESULTS 

A.  General  Remarks 

Major  problems  were  encountered  during  the  simulation  with  filter 
divergence  and  the  "debugging"  of  computer  execution  errors.  With  regard  to 
the  "debugging"  problem,  it  is  indeed  unfortunate  that  the  WPAFB  Cyber  CDC 
possesses  such  a  poor  execution  error  diagnostic;  many  hours  were  spent  in 
intriguing  but  unnecessary  searches  for  yet  another  mode  error.  On  the  other 
hand,  the  problem  of  filter  divergence  was  not  unexpected  ar.d  could  in 
general  be  traced  to  one  or  all  of  the  following  three  contributors: 

1.  The  effect  of  higher  order  terms  resulting  from  the  nonlinear  nature 
of  the  Autofocus  measurement. 

2.  The  lack  of  observability  (or  whether  there  is  enough  information 
in  the  update)  in  the  measurement  itself,  which  will  allow  }XS-XF| 
to  accumulate  indefinitely. 

3.  The  reduced  state  nature  of  the  filter  model. 

The  SOFE -simulations  were  generally  run  over  an  80  sec.  trajectory  with 
a  4  or  8  sec.  Auto-Focus  update  interval.  The  available  trajectory  was  a 
low-speed,  low-altitude  trajectory  with  some  degree  of  maneuvering  present. 

B.  Case  A: 

Using  the  complete  nonlinear  measurement  of  (15),  the  early  runs  were 

found  to  be  divergent;  that  is,  the  difference;  |XS-XF|  became  Increasingly 

large.  Originally,  it  was  thought  that  the  nonlinear  noise  contribution  to 

the  update  [which,  from  simple  algebra,  can  be  expressed  as  {(DS1)  /2(V,j,  LS’)} 

where  DS ' -XS-Xf  and  V^.  is  the  true  velocity]  wa9  the  fundamental  cause  of  the 

divergence.  To  counteract  this  effect,  the  measurement  noise  was  increased 
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but  still  the  filter  remained  divergent.  To  resolve  the  role  of  the  nonlinear 
nclse  effect,  the  nonlinear  or  higher-order  terms  were  simply  subtracted 
thereby  linearizing  the  measurement.  This  w.-ts  possible  only  in  Case  (A) 
where  the  higher  order  term  (2nd  order)  was  known  in  closed  form;  it  is,  of 
course,  impossible  to  subtract  this  term  in  practice  since  XS  is  unknown. 
However,  the  filter  continued  to  remain  divergent  even  with  this  extreme 
fix  which  seem  to  suggest  that  the  higher  order  terms  were  not  the  funda¬ 
mental  cause  of  the  divergence. 

The  next  factor  considered  was  model  divergence  or  the  effect  of  the 
reduced  order  of  the  filter  error  state-vector.  The  deleted  state  problem 


is  especially  serious  in  the  high  measurement  accuracy  case  {e.g.  Autofocus} 
since  the  filter,  as  expressed  by  its  propagated  covariance,  becomes  over¬ 
confident  as  to  the  accuracy  of  its  estimate  and  ignores  further  measurement 
updates.  In  such  a  situation,  the  subtle  differences  between  the  truth  and 
filter  are  accentuated  and  the  filter  eventually  diverges.  The  standard 
technique  for  controlling  this  type  of  divergence  is  to  artifically  inject 
noise  into  the  propagating  covariance  either  by  increasing  the  initial 
covariances  or  by  introducing  ficticious  process  noise  (Qf.  terms).  Both 
methods  were  tried  and  eventually  a  Qf  level  of  320  ft/sec  in  the  velocity 
states  was  found  effective  in  controlling  divergence.  Even  though  this 
Intellectually  unsatisfying  approach  did  control  gross  divergence,  the 
updates  themselves  were  not  anymore  effective;  that  is,  the  Kalman  gain 
vectors  were  not  receiving  and  processing  the  reassurement  in  an  effective 
manner.  By  a  process  of  elimination,  the  question  of  observability  therefore 
became  the  center  of  attention.  Initially,  the  observability  matrix  of  (13) 

was  programmed  on  the  computer  with  a  term  added,  - ItD,  to  the 

(FT)  HT  column  to  account  fot  the  time  varying  nature  of  F(t)  as  the 
operating  point  moved  along  the  trajectory.  Immediately,  it  became 
apparent  that  the  13  state  observability  matrix  would  be  singular  (zero 
determinant)  because  of  the  non- interactive  longitude  channel  (first  row 
of  F)  and  the  three  {0}  columns  of  the  gyro-drift  states.  Accordingly,  the 
13  state  matrix  was  reduced  to  9  states  and  the  program  was  rerun  over  the 

usual  trajectory.  The  results  Indicated  very  marginal  observability  with 

-20 

the  condition  number  of  the  ♦  matrix  lying  between  0  and  10  1  These 

results,  of  course,  apply  to  this  particular  trajectory  only;  other 
trajectories  may  possess  better  observability  particularly  violent  maneuvers 
where  all  three  velocity  components  are  non- zero  and  rapidly  changing.  As 
an  added  support  for  the  observability  argument,  Appendix  Ilpresents  a  2nd 
order  system  with  a  similar  nonlinear  measurement;  the  observability 
criterion  indicates  regions  of  non-observability  in  the  (X^.Xj)  state 
space. 

Although  the  properties  of  the  observability  matrix  are  an  analytically 
satisfying  way  of  investigating  observability,  a  more  direct  way  is  to  simply 
look  at  the  change  In  covariance  at  update.  Referring  to  Figure  3(a,b,c), 


for  a  high  ficticious  in  the  velocity  states  of  32,  only  the  north 
velocity  component  receives  a  significant  update  while  the  other  velocity 
components  and  the  10  other  state  variables  are  essentially  unaffected. 
Figure  4(a,b,c)  shows  the  update  effect  for  a  lower  Qf  of  3.2;  in  this  case, 
the  effect  is  less  dramatic  due  to  the  lower  absolute  value  of  the  covari¬ 
ance.  However,  the  large  correction  at  the  first  update  is  interesting  and 
was  also  reflected  in  an  excellent  Initial  filter  update.  For  some  reason, 
the  quality  of  the  update  was  not  maintained.  Figure  5(a,b,c)  gives  the 
covariance  propagation  for  Q^,  ■  0  when  the  filter  becomes  divergent.  The 
rapid  monotonic  decrease  in  is  an  indication  of  the  filter's  absolute 

confidence  in  its  erroneous  state  estimate  which  leads  finally  to  the 
divergence.  From  the  covariance  plots,  it  would  therefore  appear  that  only 
the  north  component  of  velocity  is  observable  for  this  particular  trajectory 
given  the  LN-15  dynamics.  The  system  observability  should  however  improve 
in  Case  (B)  and  Case  (C)  since  more  state  variables  are  included  in  the 
measurement  matrix. 

C.  Case  B: 

While  conceptually  straightforward,  the  inclusion  of  the  acceleration 
state  vector  in  the  SOFE  simulation  proved  to  be  quite  difficult.  A  fixed 
step  integration  mode  was  used- for  simplicity  but  problems  were  encountered 
trying  to  circumvent  the  5  step  numerical  integration  routine  that  is  a 
permanent  feature  of  SOFE.  Many  mode  or  execution  errors  were  encountered. 
It  was  only  on  the  last  day  of  the  ten  week  period  that  a  "successful"  run 
was  completed.  Early  results  indicate  an  improvement  in  observability  based 
on  the  propagated  covariance.  The  conditioning  of  the  observability  matrix 
was  not  checked  however. 

A  follow-on  grant  proposal  will  propose  completing  Cases  B,C,  and  D  and 
resolving  the  observability  question. 


IX.  RECOMMENDATIONS 


In  a  follow  on  grant  proposal,  I  will  recommend  the  following  tasks: 

(1)  Cases  B,C  and  D  should  be  completed  as  outlined.  Special  attention 
should  be  given  to  the  relative  importance  of  observability  and  non¬ 
linear  noise  in  all  three  cases.  It  should  be  emphasised  that  only  an 
investigation  of  the  complete  case  (Case  C)  can  resolve  the  potential 
value  of  the  Autofocus  update. 

(2)  If  observability  should  continue  to  be  a  problem  in  Case  C»  the  use  of 
similarity  transformations  to  Isolate  the  observable  and  conobservable 
states  should  be  considered.  The  identification  of  the  observable 
states  could  suggest  additional  state  deletion  or  addition  and  alao  the 
type  of  additional  sensor  input  necessary  to  augment  the  Autofocus 
update. 

(3)  Because  the  Autofocus  measurement  is  essentially  a  high  signal  to  noise 
ratio  measure,  the  presence  of  nonlinear  noise  could  seriously  degrade 
its  potential  usefulness.  Accordingly,  the  use  of  the  iterated, 
extended  Kalman  filter  should  be  considered. 

(4)  The  use  of  the  finite  memory  technique  for  controlling  filter  divergence 
should  be  investigated.  This  technique  is  intellectually  more  satisfying 
than  merely  adding  a  higher  noise  level  to  the  covariance  propagation. 

(5)  If  and  when  a  satisfactory  update  is  realized,  the  effects  of  different 
trajectories  and  update  intervals  should  be  investigated. 

(6)  An  adaptive  Kalman  filter  configuration  should  also  be  considered.  Ms 
suggestion  is  motivated  by  an  observed  improvement  in  attitude  error 
observability  when  the  appropriate  H  matrix  entry  was  zeroed  for 
velocity  components  below  a  certain  threshold  level. 
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14 

X  GYRO  G-SENS  DRIFT.  INPUT (X) 

RANDOM  CONSTANT 

15 

X  GYRO  G-SENS  DRIFT,  SPIN(Y) 

RANDOM  CONSTANT 

16 

Y  GYRO  G-SENS  DRIFT,  SPIN(X) 

RANDOM  CONSTANT 

17 

Y  GYRO  G  SENS  DRIFT,  INPUT (Y) 

RANDOM  CONSTANT 

18 

Z  GYRO  G-SENS  DRIFT,  SPIN(Y) 

RANDOM  CONSTANT 

19 

Z  GYRO  G-SENS  DRIFT,  INPUT (Z) 

RANDOM  CONSTANT 

20 

X  GYRO  G*G-SENS  DRIFT 

RANDOM  CONSTANT 

21 

Y  GYRO  G* G-SENS  DRIFT 

RANDOM  CONSTANT 

22 

Z  GYRO  G*  G-SENS  DRIFT 

RANDOM  CONSTANT 

23 

X  GYRO  SCALE  FACTOR 

RANDOM  CONSTANT 

24 

Y  GYRO  SCALE  FACTOR 

RANDOM  CONSTANT 

25 

Z  GYRO  SCALE  FACTOR 

RANDOM  CONSTANT 

26 

X  GYRO  MISALIGNMENT  ABT  Y 

RANDOM  CONSTANT 

27 

X  GYRO  MISALIGNMENT  ABT  Z 

RANDOM  CONSTANT 

28 

Y  GYRO  MISALIGNMENT  ABT  X 

RANDOM  CONSTANT 

29 

Y  GYRO  MISALIGNMENT  ABT  7. 

RANDOM  CONSTANT 

30 

Z  GYRO  MISALIGNMENT  ABT  X 

RANDOM  CONSTANT 

31 

Z  GYRO  MISALIGNMENT  ABT  Y 

RANDOM  CONSTANT 

32 

X  ACCELEROMETER  BIAS 

RANDOM  WALK 

33 

Y  ACCELEROMETER  BIAS 

RANDOM  WALK 

34 

Z  ACCELEROMETER  BIAS 

RANDOM  WALK 

35 

X  ACCELEROMETER  SCALE  FACTOR 

RANDOM  CONSTANT 

36 

Y  ACCELEROMETER  SCALE  FACTOR 

RANDOM  CONSTANT 

37 

Z  ACCELEROMETER  SCALE  FACTOR 

RANDOM  CONSTANT 

38 

X  ACCEL  MISALIGNMENT  ABT  Y 

RANDOM  CONSTANT 

39 

X  ACCEL  MISALIGNMENT  ABT  Z 

RANDOM  CONSTANT 

40 

Y  ACCEL  MISALIGNMENT  ABT  X 

RANDOM  CONSTANT 

41 

Y  ACCEL  MISALIGNMENT  ABT  Z 

RANDOM  CONSTANT 

42 

Z  ACCEL  MISALIGNMENT  ABT  X 

RANDOM  CONSTANT 

43 

Z  ACCEL  MISALIGNMENT  ABT  Y 

RANDOM  CONSTANT 

44 

BARD  ALTIMETER  BIAS 

FIRST  ORDER  MARKOV 

45 

EAST  ACCELERATION 

46 

NORTH  ACCELERATION 

47 

VERTICAL  ACCELERATION 

I 


FILTER 

STATE 

INDEX 

ERROR  SOURCE 

1 

EAST  LONGITUDE 

2 

NORTH  LATITUDE 

3 

ALTITUDE 

4 

BAST  VELOCITY 

5 

NORTH  VELOCITY 

6 

VERTICAL  VELOCITY 

7 

EAST  ATTITUDE 

8 

NORTH  ATTITUDE 

9 

VERTICAL  ATTITUDE 

10 

BARO  ALTIMETER  BUS 

11 

X  GYRO  DRIFT 

12 

Y  GYRO  DRIFT 

13 

Z  GYRO  DRIFT 

14 

AZIMUTH  MEASUREMENT 

15 

ELEVATION  MEASUREME 

ERROR  MODEL 

DYNAMIC 

DYNAMIC 

DYNAMIC 

DYNAMIC 

DYNAMIC 

DYNAMIC 

DYNAMIC 

DYNAMIC 

DYNAMIC 

FIRST  ORDER  MARKOV 
RANDOM  WALK 
RANDOM  WALK 
RANDOM  WALK 

AS  FIRST  ORDER  MARKOV 

BIAS  FIRST  ORDER  MARKOV 


APPENDIX  II 


It  is  of  interest  to  enelytlcelly  investigate  the  observability  of 

Case  (A).  Inasmuch  as  the  F  matrix  of  the  bH-15  is  far  coo  complicated  to 

be  analytically  tractable,  a  second-order  system  is  instead  analysed 

2  2 

using  the  nonlinear  measurement,  Xj  +  . 

Consider  the  invariant,  linear  system  given  by 


x  +  kjX  +  kjX  ■  f(t) 


which,  in  state  variable  form,  becomes 

“x.1  fo  -  1  I  fx.1  1*0 

1  A  + 

*2  ”^2  *2  ^  (t) 


(A. 2.1) 


(A.2.2) 


where  the  measurement,  ,  is  now 

2  .  2 
"X1  +X2 


(A./!.  3) 


(A.2.4) 


for  the  extended  filter.  Using  expression  (13),  we  have  for  the  observability 
sutrlx,  4, 


2xx  ~2k2X2 


2xj  2x1~2k1x2 


with  a  determinant  equal  to 

2  .  2 
x1  x2  +  x2 


(A.?. 5) 


(A.2.6) 


which  provides  the  following  condition  for  nonobservability. 


2  2 

X1  "  kl  X1  *2  +  x2  "  (xl  “  cl  *2>  (xl  ”  c2  x2>  "  0 


(A.2.7) 


Nonobasrvable  regions  of  (x1#  x  }  apace  (other  than  origin)  are  the  straight 
line a ,  x^  -  ,  if  and  only  if  c^,  are  real  nianbcrs  which  correspond  to 

the  overdamped  case  which  of  course  describe  the  P  matrix  of  the  highly 
overdamped  LN-15  INS.  Observability  with  the  "Auto-Focus"  vpdate  will  be 
further  complicated  by  the  sparaenesa  of  the  LN-15  r  matrix  and  the  fact 
that  the  measurement  involves  only  a  subset  of  state  AF  variables. 

In  aweary,  the  above  analogy  does  suggeit  that  the  AF  update  may  well 
have  serious  observability  problems. 


iAi>lj£»  vm; 


Centripedal  Acceleration  Only 


TMEAS  =  8>Q  :  Autofocus  fafc  Compass  M;  Vertical  Doppler  (nc} 

TMEASI=_J±__;  OF  -  320  . 


o  Update  Number 
• 

Longitude 

m  Latitude 

Ca>  Altitude 

■**  East  Velocity 

oi  North  Velocity 

o>  Vertical  Velocity 

•*»  East  Attitude 

»  North  Attitude 

<o  Vertical  Attitude 

l 

75 

100 

133 

7! 

42 

115 

92 

96 

100 

2 

74 

82 

125 

69 

36 

115 

89 

95 

100 

3 

73 

70 

120 

68 

31 

115 

86 

94 

100 

4 

72 

61 

124 

66 

28 

115 

83 

93 

100 

5 

71 

54 

116 

65 

25 

115 

80 

92 

100 

6 

70 

49 

115 

64 

23 

114 

71 

91 

IOC 

7 

69 

44 

115 

63 

22 

114 

73 

90 

100 

8 

68 

41 

113 

62 

21 

114 

70 

89 

100 

9 

67 

38 

113 

61 

20 

114 

66 

88 

100 

10 

66 

36 

112 

60 

19 

114 

63 

87 

100 

11 

65 

34 

111 

60 

19 

114 

59 

85 

100 

12 

65 

32 

109 

59 

IS 

113 

56 

84 

100 

13 

64 

31 

108 

.. 

59 

17 

113 

52 

83 

100 

14 

63 

30 

108 

58 

17 

113 

49 

82 

100 

15 

63 

28 

108 

57 

16 

113 

47 

80 

100 

16 

62 

28 

107 

57 

16 

113 

44 

79 

101 

17 

61 

27 

108 

56 

17 

114 

41 

78 

101 

18 

61 

26 

109 

55 

17 

115 

39 

77 

101 

19 

60 

25 

109 

55 

17 

116 

37 

75 

101 

20 

60 

25 

110 

54 

17 

117 

35 

74 

101 

^■64  M-43  M“114  M-61  M-22  M-115 

o*11.4  o*21  cj*7.6  0*4.94  a*  7.2  o*1.0 


TABLE  (B2) . 

Centrlpedal  Acceleration  Only 


TMEAS  =. 
TMEASI  =. 


Autofocus  Compass  feefc  Vertical  Doppler  (n^ 


>  Altitude 

►  East  Velocity 

3 

* 

132 

0.095 

128 

40 

125 

64 

119 

13 

116 

30 

116 

14 

115 

5 

114 

35 

113 

45 

112 

6 

111 

58 

109 

17 

108 

21 

108 

21 

109 

18 

110 

20 

110 

2 

110 

12 

111 

2 

111 

11 

rf  V  i ' 


TABLE  (B3) 

Centripedal  Acceleration  Only 

TMEAS  =  p-°  :  Autofocus  M;  Compass  M;  Vertical  Doppler  (no) 

TMEAS!=_*L_;  QF _ 320 _ 


TABLE  (B4) 

Centripedal  Acceleration  Only 

TMEAS  = - 8.Q  _ _  Autofocus  {fefc  Compass  Vertical  Doppler  (y^s 

TMEASI  = _ £3 _ ;  QF__  320 


88 

101 

85 

101 

81 

101 

77 

101 

76 

101 

73 

101 

69 

101 

66 

101 

62 

101 

61 

102 

60 

102 

56 

102 

56 

102 

54 

102 

52 

102 

50 

102 

48 

102 

46 

102 

45 

102 

43 

102 

CONTINUED 

Centrlpedal  Acceleration  Only 

TMEAS  =  s.o  _  :  Autofocus  (Y«fc  Compass  tea);  Vertical  Doppler  te} 


TMEASI  = 


QF. 


Longitude 

1 

© 

■o 

© 

*o 

3 

1 

2 

3 

8 

6 

13 

42 

37 

102 

40 

36 

103 

40 

32 

103 

38 

31 

103 

37 

30 

103 

35 

30 

103 

36 

26 

103 

34 

26 

103 

34 

25 

103 

34 

23 

103 

35 

19 

104 

34 

20 

104 

35 

16 

104 

35 

16 

104 

34 

17 

104 

Vertical  Attitude 


WVDLi  £.  \.OJ} 


Centrlpedal  Acceleration  Only 


TMEAS  =. 
TMEASI  =. 


Autofocus  ffefc  Compass  frefc  Vertical  Doppler  (y<^ 

Altitude  (Yes) 

OF  320 


1 


8 


6 


.6 


2.8 


6.2 


1.17 


.3 


2.2 


5.89 


5.5 


8.3 


10.0 


10.3 


10.7 


11.0 


11.3 


11.6 


10.7 


.9 


10 


3.5 


2.2 


3. 


6.63 


5.9 


8.0 


9.0 


9.0 


9.0 


9.0 


9. 


8.8 


8.1 


4 


5.2 


3 


46 


59.5 


8.1 


8.7 


10.6 


30 


41 


11.4 


53 


20.2 


12.6 


16.5 


15.6 


14.6 


16.2 


1.33 


.5 


6.3 


7.17 


2.92 


19 

9.0 

6. 

7 

2. 

4 

15.8 

11.0 

3. 

■ 

44.3 

43.3 

102  j 

20 

8.19 

6. 

■ 

"2" 

8  ' 

1.17 

2.34 

2. 

07 

43.6 

39.81 

103 

TABLE  (B6) 

Cantripedal  Acceleration  Only 


TMEAS  = _  8—  -  :  Autofocus  (n<);  Compass  Vertical  Doppler 

Altitude (Yes) 

TMEASI  = _ tl _ •  OF-—  32Q-  _ 


o  Update  Number 

■ 

Longitude 

m  Latitude 

9) 

T3 

3 

*  East  Velocity 

oi  North  Velocity 

o»  Vertical  Velocity 

•x  East  Attitude 

« 

3 

I 

< 

1 

z 

8 

<o  Vertical  Attitude 

i 

38 

211 

12 

28 

179 

1.10 

104 

91 

100 

2 

36 

199 

5.6 

32.4 

167 

m 

106 

89 

100 

3 

35 

183 

.8 

98 

102 

mm 

109 

84 

101 

4 

41 

177 

2.8 

48 

146 

1.5 

109 

85 

101 

5 

37 

174 

.2 

6.1 

175 

mm 

110 

83 

101 

6 

37 

171 

mwm 

51 

139 

mm 

113 

80 

101 

7 

38 

168 

33 

■91 

114 

79 

101 

8 

41 

162 

.7 

74 

122 

KS9 

116 

77 

101 

9 

45 

156 

4.5 

86 

113 

mm 

117 

76 

101 

10 

45 

156 

2.6 

34 

147 

— 

117 

78 

101 

11 

50 

152 

3.0 

100 

106 

2.8 

119 

75 

101 

12 

53 

153 

5.6 

69 

130 

3.15 

120 

77 

101 

13 

54 

151 

mm 

61 

133 

2.75 

120 

76 

101 

14 

55 

149 

1.76 

66 

130 

2.16 

121 

75 

101 

15 

56 

147 

.57 

66 

129 

2.99 

121 

75 

101 

16 

56 

145 

mm 

65 

129 

1.39 

122 

74 

101 

17 

57 

143 

.279 

66 

127 

mm 

121.8 

74 

101 

18 

55 

143 

2.46 

35 

144 

2.9 

122 

73 

101 

19 

55 

143 

2.8 

49 

135 

B9I 

123 

70 

101 

20 

55 

141 

.75 

60 

128 

KOI 

124 

68 

101 

M-44  M-161  M«2.74  M-56  M-132  f^-2.0 

0-14.2  a-19.2  o-2*.  74  o-24  o-32  o- 0.74 


>**  v—  *  , 


TMEAS  -  8-° 
TMFASI  =  48 


Centrlpedai  Acceleration  Only 

Autofocus  (N<);  Compass  (* );  Vertical  Doppler  (  y) 
QF _ 22Sl_ _ 


9 

43 

1 - 

149 

55 

84 

109 

BB 

115 

75 

101 

10 

44 

149 

59 

33 

143 

2 

114 

76 

101 

11 

47 

142 

64 

98 

99 

1.6 

136 

73 

101 

12 

50 

140 

68 

65 

120 

wm 

115 

75 

101 

13 

51 

137 

71 

62 

121 

0.259 

116 

73 

101 

14 

52 

135 

72 

63 

■HI 

0.900 

mm 

72 

101 

15 

53 

134 

71 

wm 

0.789 

116 

72 

101 

16 

53 

133 

69 

63 

120 

0.705 

116 

72 

101 

17 

53 

133 

67 

46 

130 

0.233 

ilb 

72 

101 

18 

52 

134 

67 

32 

138 

0.785 

117 

70 

101 

19 

52 

134 

66 

m.  _i 

129 

0.317 

118 

68 

101 

20 

52 

132 

65 

57 

123 

0.813 

118 

66 

101 

TABLE  \B8) 

Centrtpadal  Acceleration  Only 


TABLE  (B9) 

Centrlpedal  Acceleration  Only 


TMEAS  =  16, q  :  Autofocus  (?«)<  Compass  Vertical  Doppler  (y4» 

TMEASI  QP  320 


o  Update  Number 
• 

-*  Longitude 

k»  Latitude 

»  Attitude 

»  East  Velocity 

£ 

1 

> 

i 

5 

o»  Vertical  Velocity 

•x  East  Attitude 

Q> 

3 

1 

1 

z 

8 

<0  Vertical  Attitude 

l 

wm 

4.8 

.69 

2 

76 

57 

.33 

3 

29 

22 

1.13 

4 

1.01 

.398 

1.56 

5 

54 

35 

mm 

6 

40 

26 

n 

7 

2.8 

.737 

.969 

8 

10.0 

4.83 

1.03 

9 

2.21 

2.20 

.99 

10 

24 

14 

B91 

11 

13.1 

6.3 

mm 

12 

5.7 

2.2 

.96 

13 

4.8 

1.6 

1.5 

14 

11.3 

5.1 

1.15 

_ 

15 

7.78 

5.07 

1.66 

16 

3*17 

2.63 

.18 

17 

19 

11. 

.95 

M-l§ 

o-21 

WSSM 

M-1.09 

0-0.41 

mm 

<0  Vertical  Attitude 


TABLE  (BIO) 

Centrlpedal  Acceleration  Only 


TMEAS 


JL2  Autofocus  frefc  Compass  Vertical  Doppler  (tab 


TMEASI88  1Q48.0  -  QF. 


TABLE  (B13) 


TMEAS  =  J _ 

TMEASI  =  1048 


L.O.S.  and  Centripedal  Acceleration 

Autofocus  (if  );  Compass  f*°);  Vertical  Doppler  P0) 


TABLE  (B13) 
Continued 


L.O.S.  and  Cantrlpedal  Acceleration 


TMEAS  = _ L 


Autofocus  (y  );  Compass  (no);  Vertical  Doppler  (nc| 


TMEASI  =_ML 


QF  320 


LrtJJL.fi  K&LH) 


L.O.S.  and  Centripedal  Acceleration 

TMEAS  =.  8,0 _ ;  Autofocus  (y);  Compass  (y);  Vertical  Doppler  f*°) 

TMEASI=^i_;  QF  32°  - 


o  Update  Number 
• 

-*  Longitude 

to  Latitude 

o>  Altitude 

East  Velocity 

<*  North  Velocity 

o»  Vertical  Velocity 

"i  East  Attitude 

®  North  Attitude 

<o  Vertical  Attitude 

1 

30 

151 

153 

20 

136 

117 

102 

90 

100 

2 

26 

129 

127 

18 

104 

120 

101 

88 

101 

3 

21 

135 

135 

19 

155 

117 

102 

85 

101 

4 

19 

85 

117 

67 

16 

132 

100 

80 

101 

5 

22 

77 

123  . 

22 

49 

126 

98 

80 

101 

6 

19 

79 

123 

16 

96 

122 

96 

78 

101 

7 

16 

68 

120 

21 

38 

126 

95 

73 

101 

8 

15 

64 

120 

3 

54 

125 

93 

71 

101 

9 

15 

52 

118 

38 

9 

128 

90 

67 

101 

10 

17 

42 

118 

47 

2.5 

129 

87 

65 

101 

11 

17 

42 

120 

0.132 

44 

125 

83 

65 

101 

12 

18 

32 

115 

58 

-  - 

15 

128 

81 

60 

101 

13 

20 

29 

115 

28 

12 

125 

76 

61 

101 

14 

20 

27 

115 

20 

17 

125 

73 

59 

102 

15 

20 

24 

115 

24 

13 

125 

70 

57 

102 

16 

20 

22 

115 

23 

11 

125 

67 

55 

. 

102 

17 

19 

20 

115 

21 

12 

116 

65 

53 

102 

18 

19 

18 

117 

22 

o\ 

128 

62 

51 

102 

19 

19 

18 

119 

5 

21 

129 

60 

50 

102 

20 

17 

19 

119 

8 

30 

128 

58 

48 

102 

M-19  M-58 


M-121 


M-24 


M-41 


TABLE  (B15) 


TMEAS  =L° 


L.O.S.  and  Centrlpedal  Acceleration 

_ ;  Autofocus  (y);  Compass  (y);  Vertical  Doppler  (?) 


TMFAftl=  1048  QF. 


-*  Longitude 

•o  Latitude 

o>  Altitude 

*  East  Velocity 

ui  North  Velocity 

at  Vertical  Velocil 

•>»  East  Attitude 

•  North  Attitude 

19 

54 

110 

6 

67 

l 

98 

89 

14 

41 

70 

4 

41 

l 

97 

86 

8 

55 

94 

32 

102 

2 

96 

83 

6 

14 

69 

53 

71 

2 

93 

77 

10 

9 

34  . 

9 

0.18 

1.7 

89 

77 

6 

15 

17 

29 

51 

1.3 

86 

74 

3.8 

8.8 

15 

8.3 

5.2 

1.5 

84 

69 

7. A 

6.7 

0.117 

6.5 

17 

25 

29 


15 

9 

15 

29 

14 

16 

1.5 

54 

51 

102 

16 

9.2 

15.5 

28.7 

13.8 

15.1 

2.2 

50 

48 

102 

17 

9.3 

15 

25 

12 

13 

0.73 

48 

47 

102 

18 

9.4 

16 

19 

14 

14 

1.0 

46 

45 

102 

19 

5 

12 

18 

8 

3 

3 

37 

34 

103 

&  ' 


